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Abstract of DE19940007 

The invention relates to a method and a device for 
supporting parking of a vehicle using a parking 
assistant. Signals concerning driving status supplied by 
sensors (2) are used to calculate a theoretical 
trajectory in a function block Said trajectory consists of 
clothoid curves and/or a circular curves. Signals 
supplied by the sensors (2), in particular yaw angle 
signals and trajectory signals are used to calculate an 
actual trajectory in a function block (4). Theoretical and 
actual trajectories are then compared. The result of 
said comparison enables real-time calculation of the 
steering angle during the different phases of the 
parking maneuver for which a parameter is determined 
in a function block (5). Feed-back signals supplied by 
the sensors (2) enable exact regulation of the steering 
angle adopted during the parking maneuver. Steering 
wheel movements caused by the driver are tolerated 
but do not have any influence on the steering angle. 
The driver only has to press the accelerator and brake 
pedal to influence the speed of the vehicle. 
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Die f olgenden Angaben sind den vom Anmelder eingereichten Unteriagen entnommen 

Prufungsantrag gem. § 44 PatG ist gestellt 

® Verfahren und Vorrichtung zur Unterstutzung des Einparkens eines Kraftfahrzeugs 
® Die Erfindung befasst sich mit einem Verfahren und ei- 

ner Vorrichtung zur Unterstutzung des Einparkens eines 

Kraftfahrzeugs, d. h. mit einem Einparkassistenten. Aus 

von Sensoren (2) gelieferten Fahrzustandssignalen wird 

in einem Funktionsblock (3) eine Soll-Trajektorie berech- 

net. Diese besteht aus Klothoidbogen und/oder Kreisbo- 

gen. Ferner wird auf der Basis der von den Sensoren (2) 

gelieferten Signale, insbesondere eines Gierwinkelsi- 

gnals und eines Wegesignals, eine Ist-Trajektorie in einem 

Funktionsblock (4) berechnet Dann werden Soli- und Ist- 

Trajektorien verg lichen, und das Vergleichsergebnis er- 

moglicht eine mit den Phasen des Einparkvorgangs 

schritthaltende Berechnung des Lenkwinkels, fur den in 

einem Funktionsblock (5) eine StellgroBe ermittelt wird. 

Von den Sensoren (2) gelieferte Feed-back-Signale er- 

moglichen eine genaue Regelung der wahrend des Ein- 
parkvorgangs eingeschlagenen Lenkwinkel. Lenkradein- 

griffe des Fahrers werden toleriert. haben aber keine Aus- 

wirkung auf den Lenkwinkel. Der Fahrer muss lediglich 

Gas- und Bremspedal betatigen. urn die Fahrgeschwin- 

digkeit des Fahrzeugs zu beeinflussen. 
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Bcschrcibung 

5 Die Erfindung betriiTl ein Verfahren zur Unlerstiilzung des Einparkens eines Kraftfahrzeugs, das mil einem Lenkstell- 
motor und Sensoren zum Erfassen der Fahrzeugposition, des Fahrzustands und veranderlicher Umgebungsbedingungen 
ausgeriistel ist, wobei auf den Befehl eines Fahrers hin eine geregelle Unlerstiilzung des Einparkvorgangs millels des 
Lcnksicllcrs und gestiitzl auf vorbestimmtc Fahrzcugdatcn und auf Signale der Scnsoren ausgefuhrt wird, sowie ein zur 
Durchfuhrung des Verfahrens cingerichtete Vorrichtung. 

10 Bci cincm zur Zcit bci der Robert Bosch GmbH in der Entwicklung bcfindlichen clcktronischen Lcnksystcm wird 
durch einen am Lcnkgctricbc der Vorderradcr angebrachten clcktronisch gercgcltcn Lcnkstcllcr, ausgchend von cinem 
von cincm Lcnkradscnsor crfasstcn Fahrcrlcnkwunsch unter Bcrucksichugung von fahrdynamischen GroBen die Qucr- 
dynamik durch cine Modification des dem Fahrcrlcnkwunsch cnisprechcndcn Lcnkwinkels vcrbessert, d. h., dass das 
Fahrzcug in fahrdynamischen Situationen stabilisicrt wird. Das System wcist cincn Lenkstcllmotor auf, der dem vom 

15 Fahrcr gcstclltcn Lcnkwinkcl cincn Korrckturwinkcl hinzuaddicrt. 

Die DE 29 01 504 beschreibt ein Verfahren und cine Vorrichtung zum Einparken von Kraftfahrzcugen, wclchc mit ei- 
ncr rcincn Stcucrung des Einparkvorgangs arbcitet. Dabei werden keine den Verlauf der Einpark-Trajektorie verandcrndc 
Fccd-Back-Signalc bcrucksichtigt, sondem stall dessen feste Trajcktoricn vorgegeben. 

Aus dem Patenl FR 2 728 859 ist ein Verfahren und eine Vorrichtung zur Regelung des Einparkvorgangs bekannt. Da- 

20 bci ist abcr der Fahrcr noch zustandig, um Lcnkcingriflc durchzufuhrcn. Dazu werden Sensorcn verwendet, die den Gicr- 
winkel und den Lenkwinkel erfassen. Unbcfriodigend isl dabei, dass die Leistung des damil realisierten Systems durch 
die relativ groBe Tolzeit des Fahrers bei den LenkeingrifTen beeinlrachtigl isL 

Aufgabe und Vorteile der Erfindung 

25 

Es ist Aufgabe der Erfindung, ein Verfahren und eine Vorrichtung zur Unlerstiilzung des Einparkens eines Kraflfahr- 
zcugs so zu crmoglichcn, dass das Fahrzcug automalisch in die Parkliicke lenkt, der Fahrer aber sclbst durch Gaspedal- 
und Bremspedaleingriffe die Geschwindigkcit regelt. 

Die obige Aufgabe wird anspruchsgemaB gelost. 
30 GcmaB cincm wcscntlichcn Aspckt ist das die obige Aufgabe loscndc Verfahren gekennzcichnet durch folgende 
Schritte: 

A Erfassung einer das unterstiitzte Einparken initiierenden Befehlseingabe des Fahrers und Erzeugung eines Initia- 
lisierungssignals ; 

35 B Erfassung der momentanen Fahrzeugposition und des Fahrzustands aus den Fahrzeugdaten und wenigstens aus 

cincm Gicrwinkcl signal und aus cinem Wcgcsignal; 

C Erfassung der Umgebungsbedingungen aus von an dem Fahrzeug angebrachten Sensoren erzeugten Signalen; 
D Vorgabe einer oder mehrerer Soll-Tajektorien, die eine von der Fahrzeugposition, dem Fahrzusland, den Umge- 
bungsbedingungen und den Fahrzeugdaten abhangige Soll-Bahnkurve des einzuparkenden Fahrzeugs angeben; 
40 E Erfassung einer jeweiligen Ist-Trajeklorie, abhangig von den jeweiligen in den Schritten B und C erfassten Si- 

gnalen; 

F Vergleich der in Schritt D vorgegebenen Sol UTrajek tone und der in Schritt E erfassten Isl-Trajektorie; und 
G Bcrcchnung der jeweiligen StcllgroBc fur den Lenkstcllmotor aus dem in Schritt F crhaltcncn Vcrglcichscrgcb- 
nis. 

45 

Dabei wird das in Schritt B crfasstc Wcgcsignal vortcilhaftcrwcisc von cincm Weggcbcr, vorzugsweisc von jc einem 
an jedem Fahrzcugrad bcfindlichen Radgcschwindigkcitsscnsor, erfasst. Das cbcnfalls in Schritt erfasstc Gicrwinkelsi- 
gnal kann entweder durch cincn gccignctcn Sensor gemcssen werden odcr abcr aus gccignctcn Signalen, bspw. aus der 
Drehrate eines Drehratcnsensors und/oder aus den Radgeschwindigkeiten, rekonstruiert werden. 
50 Die Umgebungsbedingungen werden in Schritt C vorzugsweisc mittcls eines Ultraschallscnsors crfaBt. Es ist jedoch 
auch denkbar Radarsensoren oder oplische Sensoren, /.. B. Kameras, einzuselzen. Die in Schritt C erfassten Umgebungs- 
bedingungen konnen die Form oder AusmaBe einer Parklucke angeben. 

Die oder jede in Schritt D vorgegebene Soll-Trajeklorie wird bevorzugt aus einem oder mchreren Klothoidbogen und/ 
oder aus einem oder mehreren Kreisbogcn zusammcngesetzl. Ein Klolhoid ist eine ebene Kurve, deren Krummungsra- 
55 dius gemaB der Beziehung R = a • a/s (R: Krummungsradius; s: Bogenlange; a: Parameter) stctig kleiner wird. 

Um zu venueiden, dass die Lcnkbcschleunigung und der Lenkruck zu hoch werden, wird die im Schriu E berechnete 
StellgroBe einer Filterung unterworfen, die abruptc Ubergangc an den Flanken der StcllgroBe glattet. 

Eine zur Durchfuhrung des Verfahrens eingerichlele Vorrichujng weist erfindungsgemaB eine Regel-/ Steuereinheit, 
die von den Sensorcn in Abhangigkcit von der Fahrzeugposition, dem Fahrzustand und den vcranderlichcn Umgcbungs- 
60 bedingungen erzeugten Signale sowie die Fahrzeugdaten empfangl, Mittel zur Berechnung einer Isl-Trajektorie aus den 
Scnsorsignalcn und den Fahrzeugdaten, Mittel zum Vergleich der jewcils bcrcchnctcn Ist-Trajektorie mit einer vorbc- 
stimmtcn Soll-Trajcktoric und Miltcl zur Bcrcchnung einer StcllgroBe fur cincn Lenkstcllmotor aus dem Vcrglcichscr- 
gebnis auf. 

Die das Verfahren durchfuhrende RcgcWStcucrcinhcit kann iiber iMltermiltcl vcrfugen odcr iibcr Filtcrmittcl mit dem 
65 Lenkstcllmotor verbunden scin, so dass die berechnete StcllgroBc in der oben bcschricbcncn Wcisc gcfiltcrt werden 
kann. 

Das oben spczifizicrtc Verfahren und die Vorrichtung bictcn gcgcniibcrdcm Stand dcrTfcchnik mchrcrc Vorteile: 
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- Es wird kcinc cchtc clcklronischc Stccr-by-Wirc-Lcnkung bcndtigL Dcr bci dcm in der Entwicklung bcfindlichcn 
fahrdynamischcn Lenksystem eingesetzte I^enkstellmotor ist ausreichend, da er aulomalische, genaue und sehr 

feineLenkeingrifTe enndglicht. 

- Die verwendeten Sensoren ennoglichen eine genaue Berechnung der gefahrenen Bahnkurve und damit eine ge- 
naue Regelung des Einparkvorgangs mil standigen Korrekluren und Anpassungen. 5 

- Die Auswahl der jeweiligen Soll-Trajektorie und ihre Kombination aus Klothoidbogen und Kreisbogen ennog- 
licht eine einfache Beschreibung der Trajeklorie und eine schnelle Berechnung des Vergleichsergebnisses zwischen 
Ist- und Soll-Trajcktoric wahrend des Einparkvorgangs. 

- Die durch die Regel-/Steuereinheit ausgefuhrte Regelung ermoglicht ein prazises Manover und ternporare Ab- 
wcichungcn von der Soll-Trajcktoric, urn den Fahrkomfort zu erhohen. 10 

- Die Filtcrung crhoht den Fahrkomfort, da sic nickhaftc Bcwcgungcn des Lcnkrads glattcn kann. 

Die nachstehende Beschreibung beschrcibt cin bevorzugtes Ausfiihrungsbcispicl des erfindungsgemaBen Vfcrfahrcns 
und crlautert gleichzeitig die Durchfuhrung durch die crfindungsgcmaBe \fcrrichtung unter Bezug auf die beiliegendc 
Zeichnung. 15 



Zeichnung 

Fig. 1 zcigl schemaiisch Funklionsblocke der erfindungsgemaBen Vorrichtung; 

Fig. 2 zcigt graphisch die gconictrischc Grundlagc zur Enniltlung cincr Bahnkurve ubcr den Zusammcnhang zwi- 20 
schen dem Kriimmungsradius R, dem Winkel 6 und dcm Weg s; 

Fig. 3 zeigt graphisch ein Klolhoid als ein Kurve, deren Kriinunung c(s) sich linear mil dem Weg s verandert; 

Fig. 4 veranschaulicht in einer ebenen Darstellung eines Kraflfahrzeugs GroBen, die zur Bestimrnung der Klothoidbo- 
gen dienen; 

Fig. 5 erlautert graphisch eine Trajeklorie und einen Lenkwinkel fur einen Fall, wo cine Fahrt am Lenkeinschlag not- 25 
wendig isl; 

Fig. 6 zeigt graphisch cine Trajcktoric und einen Lenkwinkel fur einen Fall, wo kcinc Fahrt am Lenkeinschlag not- 
wendig ist; 

Fig. 7 zcigt cine mil dem dargcstelltcn Algorithmus crzielte Einpark-Trajektorie. 

30 

Ausfiihrungsbcispicl 

Das im naehfolgcnden Text dargestellte Ausfuhrungsbeispiel eines erfindungsgemaBen Verfahrens zur Unlerstiitzung 
des Einparkens eines Kraftfahrzcugs und einer zur Durchfuhrung des Verfahrens eingcrichtctcn Vorrichtung (kurz: Ein- 
parkassistenl) verwendet insbesondere folgende Sensoren: 35 

- Ultragschall sensoren zur Erfassung der Umgebungsbedingungen; 

- aktive Radgeschwindigkeilssensoren, die Radgeschwindigkeitssignale bis zum Stillsland des Fahrzeugs liefem; 

- einen Lenkwinkel sensor; 

- einen Drehralensensor, mil dem Sign ale iiber die Giergeschwindigkeil erfassbar sind; und 40 

- (optioncll) einen Querbeschleunigungssensor. 

Es ist denkbar, in cincm andcrcn Ausfiihrungsbcispicl dcr vorlicgcndcn Erfindung einen odcr mehrere der bcispielhaft 
angefiihrten Sensoren wegzulassen, entweder weil das erfindungsgemaBe Verfahren auch ohne das von dem entsprechen- 
den Sensor gclicfcrtc Sensorsignal voll funktionsfahig ist, odcr wcil das Scnsorsignal aus andcrcn Scnsorsignalcn rckon- 45 
struicrt werden kann. Wclchc Sensoren zur Durchfuhrung des erfindungsgemaBen Verfahrens tatsachlich cingesetzt wer- 
den kann von cincm Fachmann anhand seines Fachwisscns im Einzclfall cntschicdcn werden. Es ware es bspw. denkbar, 
auf einen Drehralensensor zu vcrzichtcn und das Drchratcn signal aus andcrcn Sensorsignalen zu rckonstruicrcn. 

Fig. 1 zeigt Funklionsblocke des Einparkassistenlen. Aus dem Block 1 stehen Fahrzeugdaten zur Verfiigung. Bei- 
spiclswcisc ist dcr Block 1 cin Spcichcr, in dcm die Fahrzeugdaten abgcspcichcrt sind. Eine altcmadvc Moglichkeit ist 50 
ein Regel-/Steuerwerk, das die Fahrzeugdaten enthall. Der Block 2 isl der Scnsorblock, dcr die oben erwahnten Sensoren 
umfasst. Der Funktionsblock 3 bcrechnet die Soll-Trajektorie in der weiter unten beschriebenen Weise und erhalt dazu 
die Fahrzeugdaten aus dem Block 1 und die Sensorsignale aus dem Block 2. 

Ein zur Ermitllung der Isl-TVajektorie vorgesehener Funktionsblock 4 erhalt ebenfalls die Fahrzeugdaten aus dem 
Block 1 und die Sensorsignale aus dem Block 2 als Eingangssignale. Insbesondere ist der Drehralensensor zur Rekon- 55 
struktion des Gierwinkels wichtig. Altcmaliv kann der Gierwinkel auch durch einen entsprechenden Gierwinkelsensor 
gemesscn werden. 

Die im Block 3 vorgegebene Soll-Trajektorie und die im Block 4 ermillelle Ist-Trajcktorie werden in einem Verglei- 
chcr 8 vcrglichcn. Aus dcm Vcrglcichscrgcbnis und aus Signalcn dcr Blockc 1 und 2 bcrechnet dcr Funktionsblock 5 die 
StellgroBe. Der Vergleich zwischen den Soli- und Ist-Trajektorien ennoglicht eine genaue Regelung des Lenkwinkels 60 
mittcls dcr im Block 5 bcrcchnctcn StellgroBe. Dicsc Regelung ist moglich, da die Lcnkcingriffc von einer Regcl-/Stcu- 
crcinhcit ausgefuhrt werden. Die im Funktionsblock 5 bercchnctc StellgroBe wird im Funktionsblock 6 gefiltert. Dicsc 
Filicrung bcwirkl cine Glatlung dcrFlankc dcr StellgroBe und crrcicht damit, dass die Lcnkbcschlcunigung und dcr Ruck 
am Lcnkrad nichl zu hoch werden. AuBcrdcm werden dcm Funktionsblock 6 auch Fahrzeugdaten aus dcm Block 1 zu- 
gefuhrt und dort gefiltert odcr in die Filtcrung dcr StcllgrbBc mit cinbezogen. 65 

In dcm Vcrgleichcr 8 kdnncn neben der Ist- und der Soll-Trajcktoric auch Fahrzuslandssignalc, bspw. die Oricntiening 
des Kraftfahrzcugs, imtcinandcr odcr mit den Fahrzeugdaten vcrglichcn werden. Der Funktionsblock 7 rcprascnticrt ein 
Siellglied, das als ein Lenkstell motor ausgebildet ist. Die Sensoren und der Lenkstellmotor konnen Teil eines fahrdyna- 
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mischen Lcnksystcms dcs Kraftfahrzeugs scin. Die zusatzlichcn Kostcn fiir cine crfindungsgcmaBc \forrichtung in cincm 

fCrafifahrzeug konnen so auf ein Minimum redzuiert werden. 
IIHe<>benbezogenauf-FigH4)esehriebenen-Funklro^ 

z. B. einem ohnehin im Fahr/eug vorhandenen Fahrzeugrechner ausgefuhrl werden. 
; Nachstehcnd werden unLer Bezug auf die Fig. 2 und 3 die geomelrischen Grundlagen zur ErmitUung einer TrajekLorie 

auf der Basis eines Klothoidbogens beschrieben. 

In Fig. 2 isL graphisch der Zusammenhang zwischen dem Kriinimungsradius R, deru Winkel 8 und dem Weg s einer 

bclicbigcn Bahnkurvc vcranschaulicht. Fig. 2 zcigt, wic der Winkel 8 sich mil der Andcrung des Wegs s in Abhangigkeit 

vom Krummungsradius R verhalt. Die Krummung c(s) ist mit Gleichung 1.1 gegeben: 



C(S) = 



de 
ds 



Gl. 1.1 



Der Winkel 8 bcrcchnct sich aus dem Weg s anhand der folgcnden Gleichung: 

Gl. 1.2 
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SO 



60 



Diese Gleichung laBt sich iniL Hilfe der Gleichung 1.1 wie folgL ausdrucken: 

$(s)=6 t +]c{s)ds Gl. 1.3 

0 

Aus dem Wmkcl 8(s) werden die kleinen Andcrungen (dx, dy) der kartesischen Koordinaten (x, y) berechnct: 



dx 



Ldy 



(8)1 |"CC 

(s)J [si 



cos (e) 
in(8) 



ds 



ds 



Gl. 1.4 



35 Die Koordinaten (x, y) werden aus der Gleichung 1 .4 abgeleilet: 

















-dx 










y 0 + Jsiri 






■dt 
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Gl. 1.5 



Die aligcincinc Gleichung 1 .5 wird fur den spczicllcn Fall der Klothoidc vcrcinfacht. Die Klolhoidc ist cine Kurve, de- 
rcn Krummung c(s) sich linear mit dem Weg s vcrandcrt. Diese Kurve wird auch als Comu-Spiralc (siehe Fig. 3) bc- 
zcichnet. 

c(s) = k • s + co Gl. 1.6 

Aus dem Einsatz der Krummung (siehe Gl. 1 .6) in die Forme! 1.5 ergibt sich: 



*o+J c °s 0 o +J(fc. w + c o ) dw Idt 



> 



If- 1 l 



v « 

was sich unlcr den Bcdingungcn: 
8o = 0,xo = 0co = 0,y 0 = 0 Gl. 1.8 
65 wic folgt vercinfachen lasst: 



Gl. 1.7 
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Die Integration der Funktionen sin(u 2 ) und cos(u 2 ) ist nicht trivial. Dafur wird die Reihenentwicklung der trigonome- 



trischen Funktionen angewandt. 



(2n) 



-t-r 
2 



(2« + l) 



Gl. 1.10 



20 



Unler beslimmten Bedingungen von Konvergenzen der Reihen (Gl 1.10) kann die Reihenfolge der Summe und der In- 
tegration invcrticrt werden. Dicsc Bedingungen sind in dem vorliegenden Ausfuhrungsbci spiel (Gl. 1.10) erfiillt. 



f. f^-T 



(2n+l)l 



Gl. 1.11 



Die Gleichung (1.11) lasst sich wie folgt (ransfonnicrcn : 



/t«0 



JfcV 



2(4n + l)(2«) 



2-(4n + 3)(2H + l) 



Gl. 1.12 
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35 



40 



45 



50 



U)J = 2 



S 10 + 120 " 9360 + ^685440 
3 " 42 + 1 320 75600 + \ 6894720 ^ 



Gl. 1.13 



60 



Die Gleichung 1.13 dicnt dazu, bcdcutcndc Punktc der Trajektoric schnell zu berechncn. Iin folgendcn Abschnitt wird 
das Vcrfahrcn angewandt, um cine Einpark-'lVajcktoric zu berechncn. 

Weiterhin wird bezogen auf die Fir. 4 bis 7 die Einpark-Trajektorie mil Hilfe eines Algorithraus berechnet, der auf der 
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vorangchend criauterten Glcichung 1.13 beruht. 



^IntDitiveftoikvofgang 

Rs sei angenommen, dass das zu parkende Fahrzeug parallel zu der Parklucke steht. Die Trajektorie in der Langsrich- 
tung wird passend zu der existierenden Parklucke vorausgesetzt Tntuitiv soil die Einpark-Trajektorie die folgenden Pha- 
sen beinhallen: 

1 . Gcradeaus riickwarts fahren, 

2. wciterfahrcn (cvcntuell langsamcr) und das Lcnkrad nach rcchts bis zu dcm Lcnkeinschlag drehcn, 

3. weitcr riickwarts fahren, 

4. Lcnkrad nach links bis zum Lcnkeinschlag drehcn, 

5. weiter riickwarts fahren, 

6. Lenkrad wicdcr gcradc stcllcn, und 

7. das Fahrzcug anhalten. 

Bcrcchnung dcs Lcnkwinkels 

Die obcn bcschricbencn intuitiven Phascn sollen formalisicrt werden. 

- Wcgen der cinfachen Handhabung von Klothoiden wird angenommen, dass die Phascn 2, 4 und 7 Klothoid-Tra- 
jeklorien sind. 

- Wegen der Symmetric des Einparkvorgangs sind die Phasen 2 und 6, 3 und 5 symmetrisch. 

Die Bestimmung der Phase 2 wird anhand der Fig. 4 hergeleitet. Die Klolhoide sind durch einen Parameter k be- 
stimmt, der auf der Begrenzung des Lcnkwinkels und der Fahr- und Lenkgeschwindigkeiten beruht. 

Die Lange der Phase 3 ist so berechnet, dass das Fahrzeug tief genug in die Parklucke fahrt. Der Einfluss dieser Lange 
auf die Trajektorie wird anhand der Fig. 6 und 7 dargcstcllt. Insbesondere zcigt die Fig. 6 die Trajektorie des Fahrzeugs, 
wenn die Phase 4 nicht existiert 

Die wichtigen Punktc fiir die Bcrcchnung der Trajektorie sind in den Fig. 5 und 6 mit den Buchstaben A, B, C, D, E, F, 
30 G, R gekennzcichnet. 

In Fig. 4 ist schematisch bei eincm Fahrzcug mit eingeschlagenen Vordcrradern der sich ergebende Radius R = l/c(s) 
und der Lenkwinkcl 5(s) dargcstcllt. Die Klothoide crgibt sich zu 

c(s) = k • s + c 0 GL 2.1 

35 

Der Ackcrmannwinkcl ist 
6(s) = arctan[L • c(s)] GL 2.2 



25 



60 



65 



c = tan 



Gl. 2.3 



Daraus ergibt sich: 



s tan 



Ft] 



Gl. 2.4 



50 Dies ergibt 



= — • tan 
k 



Ft] 



Gl. 2.5 



Der Lenkwinkel ergibt sich zu: 

L-c L-k-v 



Gl . 2 . 6 



5 = 



6» 



l+[L-c] 2 l+[L-c] 2 

Daraus crhalt man den fur die Klothoide bestimmenden Parameter: 

s. max 



k = 



Gl. 2.7 



Dabei findet eine Begrenzung der Lenkwinkelgeschwindigkeit 8 < Sm" 1 **, des Lenkwinkels 6 < Oy" 14 * und der Fahr- 
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gcschwindigkcU v < v™" stall. Das Ergcbnis dcs Einparkvorgangs mil dcm zuvor crlaulerten Algorilhmus ist in Fig. 7 
dargestelll, wclche in einem x-y-Koordinalensy stern eine beispielhafle Einpark-Trajektorie und den zugmndeliegenden 
"SotHbenkwinkel veranschaulicht ' ~ 

Urn die Sleuerung im Fahrzeug zu program mieren, wird der gefahrene Weg henougt. Im Fahr/eug wird dieser Weg 
mil aktiven Radgeschwindigkeitssensoren oder in vereinfachter Fonn mit Hilfe eines Weggebers gemessen. Die Radge- 5 
schwindigkeiLssensoren konnen die Radgeschwindigkeit bis zur Geschwindigkeit Null prazise erfassen. 

Bei dem oben beschriebenen System darf der Fahrer wahrend des Einparkvorgangs Lenkeingrifle durehfuhren. Diese 
Lcnkeingriffc habcn abcr kcincn EinfluB auf das Manover. Falls beim Einparken cin Hindernis im Wcgc stent, sol! der 
Fahrer bremsen und den Einparkvorgang stoppen. Da der Lenkradwinkel mit dem zugmndeliegenden I^enksystem sen- 
sorisch crfasst wird, werden die FahrcrcingritTc am Lcnkrad durch den Lenkstellmotor wahrend des Einparkens kompen- to 
sicrt. Diese Vorgehcnsweisc crmoglicht, dass der Fahrer trotzdem das Gcfuhl hat, den Einparkvorgang sclbst zu stcucm 
und sich deshalb wohl ftihlt. 

Aufgrund der vom Drchratenscnsor gelicfcrtcn Signale wird der Gicrwinkcl bcrcchncL Bei hochdynamischen Fahr- 
manovern kann diese Bcrcchnung u. U. zcidich problcmatisch sein. Beim Einparken trcten dagegen in der Regel keine 
Schwicrigkciten auf, da sich die Fahrgeschwindigkcit und die Dynamik des Fahrmanovcrs in Grcnzcn halt. 15 

Somit crmoglicht der Einparkassistcnt ubcr die Bcrcchnung dcs Gicrwinkcls cine cchtc Rcgclung dcs Lenkwinkcls 
durchzufuhrcn, damit die Fahrzcugoricnticrung dcm crwartctcn Vcrhaltcn cntspricht. Mit dieser Rcgelung konnen Fch- 
ler, die zu cincr Abwcichung zwischen den gefahrcnen und der bcrcchnctcn Trajcktoric fiihrcn konnen, wic bspw. Fchlcr 
in der Lcnkanlage odcr unterschicdliche Reibungcn, korrigiert werden. 

Da der Sprung dcs dcm Lenkstellmotor als StcllgroBe zugefuhrten Signals zwischen den Phascn, in denen der Lcnk- 20 
winkel konslant ist (Phasen 1, 3 und 5) und den Phasen, in denen sich der Lenkwinkel verandert, zunachst abrupt ist, wird 
die StcllgroBe in dcm in Fig. 1 gezeiglen Funktionsblock 6 gefiltert, indem die abrupten Spriinge der SlellgroBe geglattel 
werden. Dabei kann die SlellgroBe gefiltert werden, damit die Lenkbeschleunigung begrenzt ist. Da die Soll-Trajektorie 
un verandert bleibL, konnen Abwcichungcn von der Soll-Trajektorie auftreten. Es werden also temponire Abweichungen 
von der Soll-Trajektorie geduldct, urn ein gleichfbrmiges Fahrmanover zu ermoglichen und urn dadurch den Fahrkom- 25 
fort zu erhohen. Die Abweichungen zwischen der Soll-Trajektorie und der Ist-Trajektorie werden im Laufe des Einpark- 
vorgangs durch die Regel-/ Stcucrcinhcit mit Hilfc dcs crfindungsgcmaBcn Vcrfahrcns korrigiert 



1. Vcrfahrcn zur Untcrstutzung dcs Einparkens cincs Kraftfahrzcugs, das mit einem Lenkstellmotor und Sensoren 
zum Erfassen der Fahrzcugposition, dcs Fahrzustands und verandcrlicher Umgcbungsbedingungen ausgcriistct ist, 
wobei auf den Befehl eines Fahrers hin eine geregelte Unterstutzung des Einparkvorgangs mittels des Lenkstellers 
und gcstiiizt auf vorbestimmtc Fahrzeugdatcn und auf Signale der Sensoren ausgefuhrt wird, gekennzeichnet 



A Erfassung cincr das untcrstiitztc Einparken initiicrenden Bcfchlscingabc dcs Fahrers und Erzeugung eines 
Inilialisierungssignals; 

B Erfassung der momentanen Fahrzcugposition und des Fahrzustands aus den Fahrzeugdaten und wenigstens 
aus einem Gierwinkclsignal und aus einem Wegesignal; 

C Erfassung der Umgebungsbedingungen aus von an dem Fahrzeug angebrachlen Sensoren erzeugten Signa- 40 
len; 

D Vorgabe einer oder mehrerer Soll-Tajektorien, die eine von der Fahrzeugposition, dem Fahrzustand, den 
Umgcbungsbedingungen und den Fahrzeugdatcn abhangigc Soll-Bahnkurve dcs cinzuparkenden Fahrzcugs 
angeben; 

E Erfassung cincr jcwciligcn Ist-Trajcktoric, abhangig von den jcwciligcn in den Schrittcn B und C erfassten 45 
Signalcn; 

F Vcrglcich der in Schritt D vorgcgcbcncn Soll-Trajektorie und der in Schritt E erfassten Ist-Trajcktoric; und 
G Bcrcchnung der jcwciligcn SlellgroBe fur den Lenkstellmotor aus dcm in Schritt F crhaltcncn Vfergleichs- 
ergebnis. 

2. Vcrfahrcn nach Anspruch 1, dadurch gekennzeichnet, dass der Lenkstellmotor und zumindest cin Tcil der Sen- 50 
soren Teil eines fahrdynamischen Lenksyslems des Kraflfahrzeugs sind. 

3. Verfahren nach Anspruch 1 oder 2, dadurch gekennzeichnet, dass das in Schritt B erfasste Wsgesignal von je ei- 
nem an jedem Fahrzcugrad bcfindlichcn Radgeschwindigkeilssensorerfasst wird. 

4. Verfahren nach einem der Anspriiche 1 bis 3, dadurch gekennzeichnet, dass das in Schritt B erfasste Gierwinkcl- 
signal von einem gecignetcn Sensor gemessen wird. 55 

5. Verfahren nach einem der Anspriiche 1 bis 3, dadurch gekennzeichnet, dass das in Schritt B erfasste Gierwinkel- 
signal aus einem oder mchrcren in den Schrittcn B und C anderweitig gemessenen Signalen, insbesondere aus ei- 
nem Drehratensignal oder aus dem Wegesignal, rekonstruiert wird. 

6. Vcrfahrcn nach einem der vorangchenden Anspriiche, dadurch gekennzeichnet, dass die Umgcbungsbedingun- 
gen in Schritt C mittels eines Ultraschallsensors erfasst werden. 60 

7. Verfahren nach cincm der vorangchenden Anspriiche, dadurch gekennzeichnet, dass die in Schritt C erfassten 
Umgcbungsbedingungen die Form und/odcr AusmaBc cincr Parkliicke angeben. 

8. Vcrfahrcn nach einem der vorangchenden Anspriiche, dadurch gekennzeichnet, dass die odcr jede in Schritt D 
vorgcgcbcnc Soll-Trajektorie aus cincm odcr mchrcren Klothoidbogcn und/odcr einem odcr mchrcren Krcisbogcn 
zusammcngcsctzt werden. 65 

9. Vcrfahrcn nach cincm der vorangchenden Anspriiche, dadurch gekennzeichnet, dass die im Schritt E bcrechnetc 
StcllgroBe cincr Fillcrung untcrworfen wird, um zu vermciden, dass die Lenkbeschleunigung und der Lcnkruck zu 
hoch werden. 



Patcntanspruchc 
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durch folgende Schrilte: 
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10. Vcrfahrcn nach cincm dcr vorangehcnden Anspruchc, dadurch gekennzeichnet, dass Lcnkeingriffc dcs Fahrcrs 
loleriert werden, aber keinen Kinfluss auf den Einparkvorgang nehrnen. 

11. Vcrfahrcn-nach einetn-der vorangehcndcfl-Anspruche, dadurch gck c n nzetchfleVdass^die-Einparkgeschwindig- 
keit durch Gas- und Bremspedaleingriffie des Fahrers beinflusst und die Lenkwinkel ausschlieBlich durch die Stell- 
bewegungen des Lenkstellmolors bewirkt weiden. 

12. Vorrichtung zur Durchfuhrung des Verfahrens nach einem der vorangehenden Anspriiche, dadurch gekenn- 
zeichnet, dass die Vorrichtung eine Regel-/Sleuereinheit, die von den Sensoren in Abhangigkeit von der Fahrzeug- 
position, dcm Fahrzustand und den vcranderlichcn Umgcbungsbcdingungen crzeugten Signalc sowie die Fahrzcug- 
daten empfangt, Mittel zur Berechnung einer Ist-Trajektorie aus den Sensorsignalen und den Fahrzeugdaten, Mittel 
zum Vergleich dcr jewcils berechneten Ist-Trajektorie mit einer vorbestimmtcn Soll-Trajektorie und Mittel zur Be- 
rechnung einer StcllgroBc fur eincn Lcnkstcltmotor aus dcm Vergleichscrgebnis aufweist. 

13. Vorrichtung nach Anspruch 12, dadurch gekennzeichnet, dass die RcgcU/Stcucreinhcit die von den jeweiligen 
Sensoren crzeugten Signalc sowic die Fahrzeugdaten von einer andercn Stcucr-/Rcgclcinheit in dcm Fahrzeug emp- 
fangt. 

14. Vorrichtung nach Anspruch 13, dadurch gekennzeichnet, dass die andcre StcuerTRcgelcinhcit als ein fahrdyna- 
misches Lenksystcm dcs Fahrzeug s ausgebildet ist. 

15. Vorrichtung nach einem der Anspruch 12 bis 14, dadurch gekennzeichnet, dass Filtermittel in funktioneller \fcr- 
bindung mit dcr Rcgel-/Steucrcinhcit vorgeschen sind, um die von dcr RcgcU/Stcucrcinhcil bcrcchnetc StcllgroBc 
so zu fillern, dass die Lenkbeschleunigung und der Lenkruck nicht zu hoch werden. 
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